#!/usr/bin/env python
import roslib; roslib.load_manifest('block_build_manager')
import rospy
import sys

from block_build_msgs.msg import *

# Sends a string message to slu_command_parser in BuildManager.py to drop a held block
SLU_TOPIC_NAME = "/blocknlp/nl_output"

def sendgoal():
  rospy.loginfo("sending Goal")
  msg = SLUCommand()
  msg.command = "dropblock()"
  pub.publish(msg)

if __name__ == '__main__':

  pub = rospy.Publisher(SLU_TOPIC_NAME,SLUCommand)
  rospy.init_node('test_node')

  sendgoal()
